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(54) Title: SYSTEM AND METHOD FOR CONTROLLING A ROBOT 
(57) Abstract 

A control system and method for controlling a robot (1), 
which robot comprises at least three setting devices (2, 3, 4) which 
can be extended or shortened in the longitudinal direction, each 
setting device being secured via a first joint (20, 30, 40) in a fixed 
frame (6) so that each setting device is pivotable in all directions 
in relation to the frame and that each setting device is attached at 
one end via a second joint (21, 31, 41) in a movable positioning 
head (8), and also a rigid arm (10) joined to and emanating from 
the positioning head and arranged between the setting devices, the 
arm being radially guided but axially displaceably joumalled in a 
universal joint (12) relative to and rigidly connected to the frame, 
each setting device being provided with a length sensor (LSi, 
LS2, LS3), said sensors forming a part of a control system (SI) 
for controlling the location (X, Y, Z) of the positioning head in the 
work space of the robot, wherein the control system cooperates 
with a feedback control system (R2) arranged to correct the 
location (X, Y, Z) of the positioning head in the work space and 
that the control system (SI) and control system (R2) operate in 
accordance with different coordinate systems. 
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1 

System and method for controlling a robot 

TECHNICAL FIELD: 
5 The present invention relates to controlling and correcting the spatial 
location of the positioning head of a robot. In the following, the term 
"robot" also covers machine tools of NC type, for instance, since in 
certain applications the present robot acts as a numerically controlled 
machine tool. 

10 

BACKGROUND ART: 

According to Patent specification SE 8502327-3 (452 279) a robot with a 
positioning head, the robot comprising at least three setting devices 
which can be extended and shortened in longitudinal direction, is 

15 already known. Each setting device is secured in a fixed frame via a 
first joint so that each setting device is pivotable in all directions in 
relation to the frame. Each setting device is also attached at one end in 
a movable positioning head via a second joint. A rigid arm is also 
joined to and emanates from the positioning head between the setting 

20 devices, the arm being radially guided but axially displaceably 
journalled in a universal joint relative to and rigidly connected to the 
frame* 

A similar robot is also known in which the setting devices are secured 
25 in a displaceable runner via a first joint, the runner being secured in a 
fixed frame, so that each setting device is pivotable in all directions in 
relation to the frame. The joint is thus indirectly secured in the frame. 

These known robots are controlled by each setting device being 
30 provided with a motor to extend or shorten the setting device. Control 
is effected by the setting devices being controlled linearly to a 
predetermined location of the positioning head or the positioning head 
being controlled along a predetermined pattern of movement. There is 
thus no control of the set location of the positioning head, which 
35 means that the influence of force and temperature on the setting 
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devices, joints, positioning head, etc. results in a difference between the 
desired set point and the actual position. 

This difference between set point and actual position is unsatisfactory 
5 and leads to reduced accuracy in the use of the robot. 

OBJECT OF THE INVENTION: 

The object of the present invention is to increase the accuracy of a robot 
of the type described above. 

10 

SUMMARY OF THE INVENTION: 

This object is achieved by arranging a feedback control system to 
supplement the existing control system. Characteristic of the invention 
is first that the existing control system and the feedback control system 

15 indicate the coordinates of the positioning head in different coordinate 
systems. Secondly, the sensors of the feedback control system are placed 
for measurement on a part which is movable in the robot and 
accompanies its movement, but which is free of tension. The part is 
v thus not influenced by temperature or force. 

20 

The invention thus relates to a control system for a robot, which robot 
comprises at least three setting devices which can be extended or 
shortened in the longitudinal direction. Each setting device is secured 
in a fixed frame via a first joint so that each setting device is pivotable 

25 in all directions in relation to the frame. Each setting device is attached 
at one end in a movable positioning head via a second joint. A rigid 
arm is joined to, emanates from the positioning head and is arranged 
between the setting devices, the arm being radially guided but axially 
displaceably journalled in a universal joint relative to and rigidly 

30 connected to the frame. Each setting device is provided with a length 
sensor LSi, LS2, LS3, said sensors forming a part of a control system SI 
for controlling the location (X, Y, Z) of the positioning head in the work 
space of the robot. The control system thus cooperates with a feedback 
control system R2 arranged to correct the location (X, Y, Z) of the 

35 positioning head in the work space. The control system SI and 
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feedback control system R2 operate in accordance with different 
coordinate systems. 

The invention also relates to a method for controlling the location of 
5 the positioning head of a robot, wherein 

a) a control system controls the positioning head in accordance with a 
cartesian coordinate system, 

b) a feedback control system senses the location of the positioning 
head in accordance with a spherical coordinate system, 

10 c) a coordinate transformation is performed of the location of the 
positioning head from the spherical coordinate system to the 
cartesian coordinate system, 

d) the deviation obtained between set point and actual position in the 
cartesian coordinate system is added to the previous set point of the 

15 positioning head, thus producing a new set point 

e) the location of the positioning head is altered to this new set point, 

f) steps a) - e) are repeated to achieve continuous control of the set 
point. 

20 BRIEF DESCRIPTION OF THE DRAWINGS: 

In the following the invention will be described in more detail by 
means of embodiments with reference to the accompanying drawings. 

Figure 1 shows a front view of the robot in accordance with the 
25 invention. 

Figure 2 shows a view in perspective of a fix holder for a universal 

joint in accordance with the invention. 
Figure 3 shows a view in perspective of a central arm controlled in 
the universal joint, where the joint is provided with sensors 
30 operating in a separate coordinate system in accordance with 

the invention. 

DESCRIPTION OF THE INVENTION: 

The invention relates directly to a robot 1 having at least three setting 
35 devices 2, 3, 4 which can be extended or shortened in the longitudinal 
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direction, each setting device being secured in a fixed frame 6 via a first 
joint 20, 30, 40 so that each setting device 2, 3, 4 is pi vo table in all 
directions in relation to the frame 6. Each setting device is also attached 
at one end in a movable positioning head 8 via a second joint 21, 31, 41. 
5 An intermediate arm 10 is also joined between the setting devices 2, 3, 4 
and emanates from the positioning head 8. In Figure 1 the setting 
device 3 with its first joint 30 and second joint 31 is hidden by this 
intermediate arm 10, but these parts are indicated by arrows. Similar to 
the manner shown in patent specification SE 8502327-3 (452 279), each 
10 of the setting devices is in the form of a piston movable in a cylinder. 

The arm 10 is connected to the positioning head 8 and extends up 
between the setting devices. It is radially guided in a universal joint 12 
secured to the frame 6. The universal joint 12 permits the arm to slide 
15 axially through the joint while being radially guided. The universal 
joint 12 also permits the arm 10 to be turned an angle a about a first 
axis and to be turned an angle B about a second axis. The first and 
second axes intersect each other under the angle 90°. 

20 Each setting device 2, 3, 4, is operated by a motor 22, 32, 42, preferably of 
electric type, in accordance with a predetermined pattern of movement. 
The movement pattern forms the basis of a control system SI which 
activates respective motors 22, 32, 42 to extend or shorten the setting 
devices 2, 3, 4, thus causing displacement of the positioning head 8 to a 

25 specific location in its work space or to continuously move the 
positioning head 8 along a given curve in the work space. Each setting 
device is provided with an angle transducer measuring the motor 
position, which represents the longitudinal location of the setting 
device and is thus synonymous with a length sensor LSi, LS2, LS3, 

30 which sensors form a part of the control system SI for controlling the 
location X, Y, Z of the positioning head in the work space of the robot. 
The positioning head 8 is thus guided to a position X, Y, Z in a cartesian 
coordinate system, as indicated by the coordinate system in Figure 1. As 
is also clear in Figure 1, a tool head 14 is connected to the positioning 
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head 8 by connecting means 16, which determine whether the robot is 
to have 4, 5 or 6 axes. More than six axes is also possible. 

Figure 2 shows a part of the robot with the arm 10 and a universal joint 
5 housing 13 from which the inner part of the universal joint 12 has 
been dismantled. The universal joint housing 13 also carries the first 
joints 20, 30, 40 externally. As is clear in Figure 2, all these first joints 
are of universal type, i.e. the setting devices can turn in the joint above 
two perpendicular axes. However, the joints do not allow the setting 
10 devices to be displaced axially through the joints. As described earlier, 
the movement in axial direction is achieved by the setting device being 
extended or shortened. 

Figure 3 shows the arm 10 and the internal parts of the universal joint 
15 12, i.e. the parts mounted in the universal joint housing 13. These 
inner parts consist of an inner ring 18 and an outer ring 19. The arm 10 
can slide in the inner ring 18 but is locked against turning by slide rails 
50 placed opposite each other on the arm 10 and running in holders 51 
in the inner ring. Externally the inner ring is provided with fixed 
20 opposite bearing pins 60 pivotably journalled in the outer ring 19. The 
outer ring is also provided with fixed opposite bearing pins 70 
journalled in the universal joint housing 13. All bearing pins are 
arranged in one and the same plane but an axial line through the 
bearing pins of the inner ring intersects an axial line through the 
25 bearing pins of the outer ring at an angle of 90°. 

The pattern of movement for the arm 10 in the universal joint 12 is 
such that it can be turned an angle a about a first universal axis and an 
angle p about a second universal axis. The arm can also slide the 
30 distance Z in the inner ring 18. Since the arm is joined to the 
positioning head 8 this means that it can assume all the positions X n , 
Yn, Zn in a defined work space which is only limited by the construction 
of the robot. 
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Figure 3 also shows that the outer ring 19 is provided with a first angle 
sensor 71, see also Figure 1, which detects the angle a of the arm about 
the first universal axis. The outer ring is also provided with a second 
angle sensor 72 which detects the angle 0 of the arm about the second 
5 universal axis. Furthermore, a length sensor 73, preferably in the form 
of a glass scale, is arranged along the arm to detect the length location / 
of the arm. These three sensors produce coordinates corresponding to 
the location of the positioning head 8 in a spherical coordinate system 
indicated in Figure 3. This location in the spherical coordinate system 
10 represents the actual location of the positioning head 8. This actual 
location is obtained in the above-mentioned cartesian coordinate 
system by means of a coordinate transformation. 

The coordinate transformation is obtained by the equations: 

15 

X a = / since cosp 
Y a = / since sinp 
Z a = / cosa 

20 The positioning head 8 is thus controlled in the cartesian coordinate 
system to the location (Xb, Yb, Zb) representing a set point. The location 
is thereafter detected by the sensors 71, 72, 73 which indicate an actual 
location (a, p, / ) in the spherical coordinate system. The coordinate 
transformation is performed, whereupon an actual location (Xa, Y a , Za) 

25 is obtained in the cartesian coordinate system. After that the difference 
(AX, AY, AZ) is calculated between the set point and the actual position 
. in the cartesian coordinate system. This difference is finally added to 
the previous set point (Xb, Yb, Zb) in order to obtain a new set point (Xn, 
Yn, Zn). These detections and calculations are repeated continuously for 

30 feedback control, and increased accuracy of the location of the 
positioning head is achieved through compensation for force, 
temperature and mechanical deviations in the machine. 

The deviation (AX, AY, AZ) between set point (X, Y, Z) and actual 
35 location (X a , Y a/ Z a ) is thus added in the cartesian coordinate system to 
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the previous set point (X b , Y b , Zb), thus giving a new set point X n = Xb+ 
AX, Y n = Yb+AY, Z n = Zb+AZ. This calculation and correction is 
then repeated for continuous control of the set point. 

5 Figure 3 also shows that a tool head 14, movable in at least two axes, is 
connected to the positioning head 8. Turning about these axes is also 
detected by sensors 81, 82 which may also be included in the control 
system for correcting the set point. If the number of axes for the tool 
head is two, a robot with 5 axes will be obtained. More axes are also 

10 possible. 



r 
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CLAIMS 

1. A control system for a robot (1), which robot comprises at 
least three setting devices (2, 3, 4) which can be extended or shortened 

5 in the longitudinal direction, each setting device being directly or 
indirectly secured in a fixed frame (6) via a first joint (20, 30, 40) so that 
each setting device is pivotable in all directions in relation to the frame 
and that each setting device is attached at one end in a movable 
positioning head (8) via a second joint (21, 31, 41), and also a rigid arm 

10 (10) joined to and emanating from the positioning head and arranged 
between the setting devices, the arm being radially guided but axially 
displaceably journalled in a universal joint (12) relative to and rigidly 
connected to the frame, each setting device being provided with a 
length sensor (LSi, LS2, LS3), said sensors forming a part of a control 

15 system (SI) for controlling the location (X, Y, Z) of the positioning head 
in the work space of the robot characterized in that the 
control system cooperates with a feedback control system (R2) arranged 
to correct the location (X, Y, Z) of the positioning head in the work 
space and that the control system (SI) and feedback control system (R2) 

20 operate in accordance with different coordinate systems. 

2. A control system as claimed in claim 1, characterized 
in that the control system (SI) is arranged to operate in accordance 
with a cartesian coordinate system and that the control system (R2) is 

25 arranged to operate in accordance with a spherical coordinate system. 

3. A control system as claimed in claim 2, characterized 
in that a first angle sensor (71), a second angle sensor (72), and a 
length sensor (73) are placed in conjunction with the universal joint, 

30 these three sensors (71, 72, 73) indicating the actual location (a, p, / ) in 
accordance with the spherical coordinate system and cooperating with 
the control system (SI) to determine the deviation (AX, AY, AZ) 
between the spatial location of the set point (Xb, Yb, Zb) and actual 
position (X a , Y a , Z a ) of the positioning head, whereupon correction of 
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the location (X+AX, Y+AY, Z+AZ) of the positioning head in the work 
space of the robot is arranged to be performed. 

4. A control system as claimed in claim 3, characterized 
5 in that the sensors (71, 72, 73) are placed for measurement on or 

near a part which is movable in the robot and accompanies its 
movement, but which is free of tension. 

5. A control system as claimed in claim 4, characterized 
10 in that the angle sensors (71, 72) of the control system (R2) are 

placed on the universal joint (12) and that the length sensor (73) is 
placed on the arm (10). 

6. A control system as claimed in claim 5, characterized 
15 i n t h a t at least two additional angle sensors (81, 82) are connected to 

the control system, placed on a tool holder (80). 

7. A method for controlling the location of the positioning 
head of a robot, characterized in that 

20 a) a control system controls the positioning head in accordance with a 
cartesian coordinate system, 

b) a feedback control system senses the location (a, p, / ) of the 
positioning head in accordance with a spherical coordinate system, 

c) a coordinate transformation is performed of the location (a, p, / ) of 
25 the positioning head from the spherical coordinate system to the 

cartesian coordinate system, 

d) the deviation AX, AY, AZ obtained between set point and actual 
position in the cartesian coordinate system is added to the previous 
set point X, Y, Z of the positioning head, thus producing a new set 

30 point Xn = X+ AX, Y n « Y+AY, 2^ = Z+ AZ, 

e) the location of the positioning head is altered to this new set point, 

f) steps a) - e) are repeated to achieve continuous control of the set 
point. 
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8. A method for controlling the location of the positioning 

head (8) of a robot as claimed in claim 7, characterized in 
that the method is used in a robot (1) as claimed in claim 1. 



5 
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